General Disclaimer 


One or more of the Following Statements may affect this Document 


• This document has been reproduced from the best copy furnished by the 
organizational source. It is being released in the interest of making available as 
much information as possible. 


• This document may contain data, which exceeds the sheet parameters. It was 
furnished in this condition by the organizational source and is the best copy 
available. 


• This document may contain tone-on-tone or color graphs, charts and/or pictures, 
which have been reproduced in black and white. 


• This document is paginated as submitted by the original source. 


• Portions of this document are not fully legible due to the historical nature of some 
of the material. However, it is the best reproduction available from the original 
submission. 


Produced by the NASA Center for Aerospace Information (CASI) 



/ 



















i^^f' CF " 152692) THE OYNAMICo AND OPTIMAL K77 ,?iuc 

-“Liscop?? -nxi™ SP ' C£C3AFT **» WOVABJ.S 
^.L^COPIM, AtPFNEAGES, PART \ ''inal Report 

(Howard Unrv. ) 77 p HC AOS/IF \c 1 CSCl 22B Ur.cl aJ 

GJ/1o 2o1<!1 


final report 

NASA GRANT: NSG - 1181-Suppl. 1 

PART A 











HOWARD UNIVERSITY 
SCHOOL OF ENGINEERING 
DEPARTMENT OF MECHANICAL ENGINEERING 
WASHINGTON, D.C. 20059 


FINAL REPORT 

NASA GRANT: NSG - 1181 - Suppl. 1 

THE DYNAMICS AND OPTIMAL 
CONTROL OF SPINNING SPACECRAFT 
WITH MOVABLE TELESCOPING APPENDAGES 

PART A 


by 


Peter M. Bainum 

Professor of Aerospace Engineering 
Principal Investigator 


and 


R. Sellappan 

Graduate Research Assistant 


May 1977 



ABSTRACT 


This report considers the dynamics and optimal control of 

i 

spinning spacecraft with telescoping appendages and is an extension 
cjf the research reported in Parts I and II (May 1974 - May 1976) . 

Part I concentrated on the analysis of the motion of a spinning 
spacecraft during the deployment of telescoping type of varying 
length appendages and fixed length appendages whose orientation with 
respect to the main hub can vary. In addition, the use of tele- 
scoping appendages to detumble a spacecraft with random spin was 
also considered. In Part II, the motion and stability analysis of 
spinning spacecraft with hinged appendages and an application of the 
linear regulator theory using a quadratic performance index were con- 
sidered. Also, the time optimal control with a single boom system 
was considered analytically. 

In this report, the problem of optimal control with a minimum 
time criterion as applied to a single boom system for achieving two 
axis control is treated in detail. The special case where the initial 

i 

conditions are such that the system can be driven to the equilibrium 
state with only a single switching manuever in the bang-bang optimal 
sequence has been examined analytically. The system responses are 
presented. Next, our previous application of the linear regulator 
problem for the optimal control of the telescoping system is extended 
to consider the effects of measurement and plant noises. 


The noise uncertainties are included with an application of the 

■ .v. .n ' = 

estimator - Kalman filter problem. Different schemes for measuring 
the components of the angular velocity are considered. Analytical 
results are obtained for special cases and numerical results are 
presented for the general case. 
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I. INTRODUCTION 


This report will describe a continuation of the NASA sponsored 

research already accomplished during May 1974 - May 1976 (Parts I and 

II) on the dynamics of spin stabilized spacecraft with movable appendages , ^ ^ 

In Part I, the equations of motion have been developed for the telescoping 

boom system where all the appendages are extended along the hub principal 

axes. A control strategy based on an application of Lyapunov's second 

method was used to recover a randomly tumbling spacecraft and approach 

a final state of either zero inertial angular velocity or a flat spin 

*1 

about one of the hub principal axes.- L,J The dynamics of this system 
during nominal deployment of the booms with a small nutation angle have 
also been considered both analytically for special cases of a nearly 
spherical hub, and numerically for the more general case. ^->4 

In Part II, the following topics were treated: the dynamics and an 

extensive stability analysis of a spacecraft with hinged appendages of 
fixed length; 4 ’ an examination of linear optimal control theory as applied 
to the deployment maneuver of a telescoping boom system (offset from the 
hub principal axes) by selecting different integrand function; 2 >6 
the time optimal control of a nutating spacecraft using a single offset 
telescoping boom system. 2 

The topics considered during the present NASA grant are: the pro- 

blem of optimal control with a minimum time criterion for a single offset 
boom system; and an application of the linear regulator problem for the 
optimal control of the offset telescoping system with measurement and 
plant noises present. 
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The first phase of the current study will examine the time optimal 
control of a nutating spacecraft using a single offset telescoping 
boom system. This is an extension of the work consdiered in Ref. 2. 

It is assumed that the spacecraft consists of a rigid central hub and 
a movable telescoping boom with an end mass which is linearly offset 
from the nominal hub spin axis. An advantage of such a telescoping 
system as used in the control of a spinning spacecraft system is its 
potential reuse. The use of such a moving (internal) mass device for ' 
the de tumbling of - spacecraft was first proposed and described by Edwards 
and Kaplan. The motion of the control mass was along a linear track 
fixed in the vehicle where the control variable was taken as the mass 
acceleration relative to the main part of the spacecraft. 

The optimal control of a spin-stabilized spacecraft with one or 
two movable telescoping booms was the subject of a recent paper. 6 
The boom end mass positions were controlled such that a quadratic 
cost functional involving the weighted components of excess angular 
velocity plus the control effort itself was minimized when the terminal 
time was unspecified. For such a system, the computation of the control 
law involved the solution of the matrix Riccati algebraic equation. 6 
It was concluded that for three-axis control at least two offset booms 
(moving orthogonal to each other) would be required, whereas two -axis 
(nutation) control could be achieved by using a single offset boom 
constrained to move parallel to the spin axis. 6 
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A very recent investigation by Kunciw and Kaplan^ utilizes a 
first-order gradient optimization technique to show how a movable mass 
control system may be employed to detumble a general asymmetric space 
station about a principal axis in minimum time. Results indicate 
that the de tumbling time is minimized for larger values of control 
mass and lengths of the linear track. 9 

The present study extends the work of Ref. 6 and complements 
that of Ref. 9 by analytically determining the boom (mass) control logic 
such that the terminal time will be minimized for the case where two- 
axis control of a symmetric spacecraft is required. The equations 
of rotational motion are developed and linearized about the desired 
final state. This problem lias been examined analytically for the special 
case of a single offset boom where it is assumed that the initial conditions 
are such that the system can be driven, to the equilibrium (rest) state 
with only a single switching maneuver in the bang -bang optimal sequence. 

For this system it is possible to obtain an analytical solution for the 
switching and final times in terms of the initial conditions and magnitude 
of the maximum value of the control force. 10,11 A 2 S0 the required boom 
motion can be determined analytically for this linear system. Some typical 
numerical results based on these solutions are discussed _ 

The second phase of this year's study in the area of optimal control 
extends the previous application^ 0 f the deterministic linear regulator 
problem for the optimal control of an offset telescoping boom system to 
include the effect of noise uncertainties both in the plant as well as 
in the measurements. 
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The differences between the desired state vector components and the 
actual components with noise included are now incorporated within 
the control logic with an application of the Kalman filter. ^ 

An application of modem control theory to nonrigid spacecraft 
has been very recently considered in Ref. 13. Here the established 
procedures of linear quadratic Gaussian optimal estimation and control 
were developed and interpreted for their application to the problem 
of attitude control of spacecraft with dynamically significant elastic 
appendages. The conclusions were that the techniques of modem control 
theory offer promise for practical applications such as spacecraft 
attitude control, but that the mathematical theory of modeling needs 
development and the limitations of spacecraft computer capacity require 
reduced estimator models. 13 

The present study is an extension of Ref. 6 where the measurement 
noise and plant noise are now considered in the design of the optimal 
controller. The equations of rotational motion are developed and lin- 
earized about the desired final state. For the purpose of simplicity, 
the actuator dynamics (the motor-drive mechanism that extends of retracts 
the booms) will be ignored and the boom mass dynamics will be treated 
as the control variables. (The assumption was also used in Ref. 13 for 
a different application.) The measurement noise and plant noise in the 
physical system are assumed to be white Gaussian processes with zero mean. 

For the linear system with quadratic performance indices, it has 
been shown 1 2 that the optimal control logic is a Kalman filter used in 
conjunction with the optimal deterministic controller. 
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The model of the estimator (filter) is the same as that of the ’’plant 
model.” The average performance (RMS value) of this controlled system 
in the presence of noise can be predicted from the covariances of the 
error and estimate. 12 The general system response fob non- zero initial 
conditions is obtained by simulating the linearized equations with the 
control and filter gains as obtained from their respective matrix Riccati 
differential equations. 

Both two and three axis optimal control of spinning spacecraft using 
movable telescoping offset boom systems will be considered. The dynamics 
of such a system will be studied analytically for special cases and 
numerically for the general case. 
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II . TIME OPTIMAL CONTROL WITH SINGLE 
OFFSET BOOM 


For satellites with high attitude accuracy, control jets are 
often required. However, the maximum torque produced by the jets will 
be bounded. Also the operation of the thrusters are often limited by 
the weight and propellant capacity of the thruster system. Instead 
of jet systems, externally movable appendages can be used for controlling 
the attitude of the spacecraft. 6 The main advantage of movable appendages 
is their potential reuse. Optimal control theory can be applied to 
minimize the time required for returning the state of the (linear) system 
to its nominal value. 


1. Statement of the Time Optimal Control Problem 

The equations of motion of a linear, controlled time- invariant system 
" [ 
are represented by: 

X’ = AX + BU (2.1) 

where 


X = state vector of the system 
A = system (plant) matrix 
B = control matrix 
U = control vector 

. I : . . .. ' . . . .. ... . r > ' • ' ' ' 

Here the problem of determining the control U ( | U j <_ C) which forces 
the system (2.1) from the initial state, X(O), to zero state in 
minimum time is treated . 
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An admissible control U(t) , transferring the system state from 
X(0) to X(t£.) = 0, is found from the solution of Eq. (2.1) given by 

X(t) = e Ax X(0) + / 0 T e A ^ x " < ^ BU(<(>) d<f> (2.2) 

For XCx^) = 0, Eq. (2.2) reduces to 

/ 0 x f e -A * BUfo) d<|> = -X(0) (2.3) 

Equation (2.3) will be used to determine the switching and final times 
of the control. 

2. Application to Single Offset Boom System 

As an application of the time optimal control theory, the movable 
single offset boom system as a two-axis nutation damper is shown in 
Fig. 2.1. The equations of rotational motion are developed and linearized 
about the desired final state of a spin about the z axis only (to z =n) . 2 
The linearized system equations (Ref. 2, Eqs. (5.4) and (5.5)) for the 
special case of a symmetrical hub (b=0, without loss of generality) 

; j . 

result as: ; ; "■ | 

"a l fo -el M TO 1 [U] (2.4) 

A T d °J L 3 J l 1 } 


where 

U = n(?" + ?) (2.5) 

d = (I 3 - I + c 1 2)/(T + c x 2 ) (2.6) 

; y ^ (I 3 - I) /I (2.7) 

n = c x /CT + c 1 2 ) (2.8) 
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The nondimensionali zed quantities are defined as: a = w-j/ft; 

$ = w 2 /fi; C]_ = a/%; c = z/%; Ij_ = I^/yJfo (i = 1,2,3) and for the assumed 
symmetry, % = T 2 = T; x' = fit; and x represents the nondimens ionless 
time. The variational coordinates are a, 3 whereas t, represents the 
control variable and describes the end mass position. From Eq. (2.4) 
it is seen that the equations for the transverse angular velocity 
components have the form of a coupled two dimensional harmonic oscillator 
under the influence of the boom motion as a control force. 

The solution for U(t) , bringing the system state to rest in minimum 
t£, is known to be U(t) = +C, with the number of switches depending upon’ 
the initial state of the system. 1° Considering the initial states that 
can be driven to rest in a single switch (Fig. 2.2(a)), the control takes 
the formal 


i U(x) = for 0 _< t <_ x s ; U(t) = K 2 for t s <_ x_<_ x£ (2.9) 


where 


K x l - |K 2 I - C 


The state transition matrix, basing A on Eq. (2.4), is 

cos ojqx _ e_ 


Ax 


Id . "0 

— Sin WnT 

wo u 


Sin WrvX 

IDn u 


cos wqx 


( 2 . 10 ) 


where 


Wq = / de 


After substitution of Eqs. (2.9) and (2.10) into Eq. (2.3), one obtains 
(1 - COS WQXg) K-£ - (cos WqX£ - cos WqX s ) K 2 = a(0)d (2.11) 
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(sin wgT s ) K 1 + (sin - sin u 0 t s ) K 2 - "3 (0)u>q (2.12) 

The expressions for the switching time, T g , and the final time, x^, 
are obtained by solving Eqs. (2.11) and (2.12), with the result: 

T s ” i~ ( tan' 1 /Cfj'/giF -1 -tan' 1 (F/E) > (2.13) 

“0 " 

x f = 1 * tan" 1 > / (g 4 /g 3 )^-l -tan' 1 (F/E) } (2 14) 

where “° 

E = a(0) d + K^; F = 0 (O)u)q 

gl = (2K 2 - %) K x - (E 2 * F 2 ) 

g 2 =■ 2(K 2 - Kj) v'"E 2 +F r (2-15) 

g 3 = (2K 2 - Kj-): % + (E 2 + F 2 ) 
g 4 - 21^ / E^+F 2 

The control scheme for single switching and the phase plane response 

T 

of the system for a given initial condition X(0) = [a(0) 0(0)] are 
shown in Figs. 2.2(b) and 2.2(c), respectively. 


3. Switching Boundary Determination 

The solutions for a(t) and 0(t) are obtained from Eq. (2.4), with 
U(t) = C, as: 

a CO = (a(0) + j) COS WqT - 0(0) sin WqT - ^ (2.16) 

0(0 = ^ (a(0) + ^) sin UqT + 0(0) cos WqT (2.17) 

U)Q 

The equation of the trajectories in the a CO* B(0-j- pi 3116 can 
represented by: 

(a(t) +|) 2 + C8W^) = (a(0) + £) 2 + (3(0)^) 2 (2.18) 
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These trajectories are circles with centers at (C/d,0) . The switching 
boundary is composed of semicircles passing through the origin. For 
any given initial state X(0) , the system state moves on the switching 
boundary (passing through the origin) for t s <_ x <_ t£ as shown in Figs. 

2.2 (a),(c). 

In order to reach the origin with a single switching maneuver under the 

assumption: 0(O)=O, the magnitude of the initial value a(0) is restricted by: 

| a (0) j < 1 2C/d| (2.19) 

The control U(t) assumes the value K-^= +C and "G for the given 

initial state X(0) where a(0) satisfies Ineq. (2.19) and 0(0) - 0. 

Equations (2.13) and (2.14) are now used to obtain the switching time, 

x , and final time, t£, for this initial condition. The expressions 

for t and for this case become: I 

s± 



T f = 4 tan ' 1 [/(§^)' J; i _ ] < 2 - 21 ) 

4. System Response - Analytic Results 




The solutions for a(x) and g(x), obtained using Laplace transform 
techniques, can be expressed as (g(0) = 0): 

(V 

a(x) = a(0) cos ojgT - ^ [(1 - cos Wqt) a(x) 

-2(1 - cos co 0 (t-t s ) a(T-x s )3 

B(x) = a(0) sin o>qT + [sin wqX a(x) 


-2 sin w 0 (t-t s ) a(x-T s )] 


a(x) = unit step function 

b. Time Response of the Control Mass Position 

The equation of the boom end mass displacement is obtained from 

Eqs. (2.5) and (2.9) and expressed by 

n(?"(x) + ?(x)) = -C for 0 <_ x <_ x s 

= + C for x < x < Tr 
s — — x 

and hence the time response of the control mass 'is given by the 
following equation (x _> 0) : 


?( T ) = £ [i|» 1 (t)- 24 » 1 (x-x s ) +i{» 1 (x-x £ )] 


where 


^(t) * (1-cos x) a(x) 

When linear damping (p) is assumed to be present in the boom extension 
mechanism, Eq. (2.25) becomes 

n(?"(x) + 2p?'(x) + c(x)) = U(x) (2 
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The solution of Eq. (2.27), with U(t) given in Eq. (2.9), can be 
written as 

. C 


C(*0 = - D|> 2 (t)- 2 ^ 2 ( t -t s ) + ’I' 2 Ct*t £ )] 


(2.28) 


where 


= 1 - ; 


e~ pT 

v ry 


: sin(A-p^ t+$) a(-c) 


$ = cos” 1 (p) = tan" 1 0H£? /p) 


5. Simulation Results 

■ - i ■ 

: i- 

In this section some typical numerical results are presented. The 

2 

following system parameters are selected (Fig. 2.1): 

I =1.42 x 10* 7 kg-m 2 (10.5 x 10^ slug-ft 2 ) 

I 3 * 2.03 x'10 7 kg-m 2 (15 . 0 x 1,0 6 slug-ft 2 ) 

M = 6.21 x 10 4 kg (4258 slug) 

Q = 0 . 314 rad/sec (3 rpm) 
m = 816 kg (55. 95 slug) 

a = 19.8 m(65ft) , b =0, £ m = z max = 5.4m(17.72ft) 




^(0) = 0.0391 rad/sec, u-(0) = 0,0)™ = 0.04 rad/sec. 

1 z i max 

Fig. 2.3(a) illustrates the variation in the switching time, t 
and final time, t £ , with the normalized value of control effort for 
a given set of initial conditions: cu £ (0) = 0.0391 rad/sec and o^CO) = 0, 

In order to achieve the desired final state with a single switching 
maneuver, the magnitude of C must be greater than 0.0275. The final 
time is rapidly reduced for small increases in the control effort near 
the minimum value. 
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For a control effort of C = 0.03 and a^CO) = 0, the magnitude of 
oj^(O) must be less than 0.0427 rad/sec, for a single switching maneuver. 
These conditions are obtained from inequality ( 2 . 19 ). Fig. 2.3(b) 
demonstrates the manner in which the final time required increases 
with the larger values of w^(0), whereas the switching time remains 
essentially constant over a wide range of initial conditions. 

The comparison of nutation angle decay for three different 
control laws is depicted in Fig. 2.4. Initial conditions for all 
cases were selected such that the initial nutation angle was 5.0 
degrees. In the first case, a control law described in Ref. 7 (not 
based on optimal control theory) was used, which resulted in a 
final time of 850 seconds to remove the effect of nutation. 

Next, the response of the system using a control law based on 

2 

minimizing a quadratic performance index is presented. The process 
of determining the weighting matrices for the nondimensionalized form 
of the state equations is now discussed. (This was not considered 
in Ref. 2.) 

The original equations of the controlled system in the time 
domain are expressed as: 

X = A X + B U (2.29) 

ooooo 

and the cost functional by: 

J = /* (X T Q X + U T R U ) dt (2.30) 

The dimensionless equations corresponding to Eqs. (2.29) and (2.30) 
for the two axis control using a single boom are 

x* - ax + BuYrY';;^ (2.31) 
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J = F (X T QX + U T RU)dx 

where the prime indicates differentiation with respect to the 

dimensionless time, t = at. Then, Q and R in Eq. (2.32) can be 

related to Q q and R q in Eq. (2.30) by: 

2 3 

Q«QQ,R»aqR 
x x o 9 m o 

The values of Q and R are selected as:^ 

0 


(2.32) 


(2.33) 


Q 0 = 


q 0 

0 

0 q. 


, R = [r ] 

o L o J 
1x1 


where 




(2.34) 


(2.35) 


i o • T max 

The matrices, A and B, are readily obtained by comparing Eq. (2.4) 
with the general form, Eq. (2.31). 

The nutation angle decay of the system for the parameters: co T max 

0.04 rad/sec (maximum expected value of transverse rate) and [r ] = 
0.00372 m^ sec" ^(0.04 ft 2 sec ^)is shown in Fig. 2.4 by the dotted 
curve- The nutational motion has been effectively removed within 
200 secs after control initiation which is about one-fourth of the 
time obtained using non-optimal control method (Ref. 8) . 

(It should be mentioned that the recent results of Ref. 9 indicate 
that the gradient technique permits recovery in about one- fourth the 
time when compared with the non-optimal control law of Refs. 7,8). 

The response time of the nutation decay can be improved by properly 
varying the weighting matrices in the performance index. 
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I£ a control law is now selected based on the single switching 
time optimal criteria, a further improvement in response time is 
obtained. The final time obtained from Eq. (2.21) is 19,47 secs. 

This analytical result is shown in Fig. 2.4. In Fig. 2.5, a 
comparison of this analytical result with the numerical integration 
for the time optimal control system is presented. It is seen that 
the initial decay of nutation angle (Fig. 2.5 (a)) is extremely 
rapid approaching a value of 1.1 deg. at the end of the control 
maneuver (19.47 sec.). With this control mass of 816 kg. (55.95 slug), 
the analytic solution begins to diverge from the numerical integration 
results towards the end of the control sequence (Fig. 2.5 (a)) due 
to the presence of nonlinearities associated with the larger amplitudes 
of the control mass displacement (Fig. 2.5 (b)). To remove the residual 
nutation angle here a second switching sequence would be required. 

Also, it is seen from Fig. 2.5(b) that after approximately 30 secs, 
without damping in the boom extension mechanism a steady state boom 
motion would remain with an amplitude of 109.35 ft. (33.33m) with 
the presence of the boom damping shown, the amplitude of this motion 
has been completely reduced to within 175 secs. Here, it is 
observed that initially the boom end mass undergoes a very large displace 
ment. 

In order to reduce the large displacements of the end mass , the 
time optimal control of the system with a larger size control mass 
and a larger main spacecraft mass will be considered. 
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The values of the masses selected are 

M = 19.98 x 10 5 kg (1.37 x 10 5 slug) 

m = 2.625 x 10 4 kg (1800 slug) ; f i 

such that m/M remains at 0.013 (as in Fig. 2.5 (a)). The other 
system parameters will remain the same as considered earlier. 

Figs. 2.6(a) and (b) show the variation of switching and final 
times with the control effort and the initial conditions with the 
new mass parameters. For the same set of initial conditions, in order 
to achieve the desired final state with a single switching maneuver, 

C > 0.042, and with C = 0.05 and a 2 (0) = 0, <^(0) < 0.0472 rad/sec. 

The decay of nutation angle using the control law described in Refs. 

2,6 and that resulting from implementation of the time optimal control 
with a single switch is compared in Fig. 2.7(a). The motion of the 
boom end mass during and immediately after the nutation decay is 
illustrated in Fig. 2.7(b). It is seen that a steady state oscillation 
without damping in the boom extension mechanism would remain with an 
amplitude of 17.18ft. (5.24m) with the presence of the boom damping 
shown, the amplitude of this motion has been reduced to 2.1 ft. (0.64m) 
at 75 secs. For the time optimal results shown, there is negligible 
difference between the analytic solution and the results of numerical 
integration. 

The time response of the transverse angular rates for the case 
of Fig. 2.7 is presented in Fig. 2.8. It is observed that the closed 
form solutions give an excellent correlation with the numerical inte- 
gration for the large masses, whereas for the smaller masses the closed 
form solution diverges from the numerical integration results due to the 
resulting large amplitude boom motion. 
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Fig. 2.9 represents the dynamic response of the time optimal 
control system with a control effort of C = 0.1 which is twice of 
the previous value considered with the presence of the larger control 
and main spacecraft masses. It is observed that the steady state 
oscillation of the boom end mass increases from 17.18 ft. (5.24m) 
to 31.05 ft. (9.46m) for an increase of control effort from C = 0.05 
to C = 0.1. The complete control manuever time is reduced to 9.929 sec. 
from 14.56 sec. 

For the general case where the initial conditions do not lie 
within the single switching region piecewise solutions can be used to 
obtain the system response analytically, or, as an alternative, the 
more general gradient technique of Ref. 9 can be employed. 
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III. OPTIMAL ESTIMATION AND CONTROL 

This chapter deals with the application of optimal estimation 
and control techniques to the attitude control of spinning spacecraft 
with movable telescoping appendages. The estimation is accomplished 

i 

using a Kalman filter to obtain estimates of the state (variation of 
the angular velocity components) of the spacecraft; this estimated 
state constitutes the input to the controller, Iii the controller a 
quadratic performance index is formulated to minimize the components 
of excess angular velocity plus the control effort; additionally, 
a linearized model of the overall system is employed. 

i i ■ 

The attitude control of a spinning spacecraft with the use of 
one or two movable telescoping appendages is considered (Fig. 3.1). 

The performance of the system is evaluated by analytical methods 
for special cases and numerical integration is used for the general 
case. In this analysis, the dynamics of the driving mechanism are 
completely ignored, and the control effort needed for the boom movement 
is assumed to be present instantaneously. 

1. Formulation of the Stochastic Optimal Control Problem 

This section describes the application of well-known results in 
optimal linear estimation and control theory to the problem of attitude 
control of spinning spacecraft. The linear equations of state X and 
measurement Y are 

X' = AX + BU + Gw (3,1) 

. — Y = HX + v ' '■ (3,2) 
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where the elements of the system state vector, X, represent the 
variation of angular velocity components of the spacecraft from a 
nominal state, and the elements of the measurement vector, Y, correspond 
to the measured components of X with noise present. The vector, w, i 
represents random disturbances that perturb the spacecraft, and the 
vector, v, represents the measurement noise present in the sensors. 

The measurement noise (v) and the plant noise (w) are assumed to be 
white Gaussian processes with zero mean. 

I The cost functional to be minimized here is taken as a weighted 
quadratic function of the state vector plus a weighted function of 
the control: 


J = E { 


£im 


T f 


CP 





(X T QX+U T RU)dx} 


(3.3) 


The optimal control vector U minimizing J for control over the internal 
0 < t «=° can be expressed as : ^ 

U = -CX (3.4) 

where the control gain, C, is related by 

C = R'Vk (3.5) 


In Eq. (3.5) K is the steady state solution of the matrix Riccati 
differential equation 


-K’ = ka+a t k-kbr _1 b t k+q 

(3.6) 

The estimated state, X,is obtained from 


X’= AX+BU+F(Y-HX) 

(3.7) 

with the filter gain ^expressed as: 


-"f.* phV 1 

(3.8) 


Again P in Eq. (3.8) results from the steady state solution of the 
following matrix Riccati differential equation, 

pi = ap+pa t -ph t v' 1 hp+gwg t 


(3.9) 


The quantities W (covariance of the plant noise) and V (covariance 

of the measurement noise) are obtained from the following autocorrelations: 

,T 


12 


E (w(x) w(t+4>) } = W <5(4>) 

E (v(t) v(t+<J>) T } = V 5(<f>) 
where 6(<j>) represents the Dirac delta function. 


(3.10) 

(3.11) 


2. Application to Two Axis Control with a Single Offset Boom 

The optimal estimation and control theory stated in Eqs. (3-1) - 
(3.11) will be applied, at first, to a single offset-boom system providing 
two axis control and then to a two offset-boom system f or three axis 
control. The present study is an extension of Ref. 6 where the measurement 
noise and plant noise are now considered in the design of the optimal 
controller . 

The movable telescoping single offset system (m 2 =0) is now analyzed 
(Fig. 3.1). The linearized equations of motion in dimensionless form 
(Ref. 2, Eqs. (5.4) and (5.5) and Ref. 6) for the special case of a * 
symmetrical hub result as (for b=0) : 


m r o 

■ — 

0) 

1 


a 


i 

o 

1 

II 




+ 


M d 

0 


3 


11 

L J L 

_ 


» . 


L J 


[U] 


(3.12) 


where 


U = +c 


(3.13) 
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The other quantities in Eq. (3.12) are defined by Eqs. (2.6) - (2.8). 
Eq. (3.12) can be written in the form: X' = AX+BU. The matrices 


A and B resulting from Eq. (3.12) are 
A= 


_fo -el . B JO 
d 0 ’ B In 

m J L « 


-e 

0 


(3.14) 

We further assume that the control, U, and the plant noise, w, enter 
the system as shown in Fig. 3.2. Thus, the equations of motion of the 
system, with the plant noise present, can be modified to the form shown 
in Eq. (3.1). 

a. Single Measurement System-Analytic Results 
(1) Control and Filter Gains Evaluation 
The details of the steady state control gain evaluation are available 
in Refs. 2 and 6. Here only the results are stated. The elements of 
the K matrix are 


12 ■ hi 1 Cr/n 2 ) [d i M^Cq/lOr 5 ] 

(3.15) 

22 = - ( r / n )Uq-2eK 12 )/r}'- 

(3.16) 

: u = (K 22 /e)td-n 2 (K 12 /r)} 

(3.17) 


where the sign in front of the radicals is selected such that K is 
positive definite. The weighting matrices Q and R in the performance index, 
J, Eq. (3.3), have been selected for the present application as: 

m 

0 


Q= 


q 

o 


and R =[r! (3.18) 

It should be noted that previously for convenience R was selected as the 
unit matrix. From Eqs. (3.4), (3.5) and (3.13) it is seen that the 
control has the form 

U = S ,,+ 4 = -[C, C-] (X) (3.19) 



where the control gains are obtained from 

C 1 “ nK i2 // ' r ’ C 2 = »V r (3.20) 

Next’, the steady state filter gain determination from Eq, (3,9) is 

considered. For this application of two axis control with a single mea- 

T 

surement of a such that H = [1 0] ,we assume that the control , U, and 
the plant noise, w, enter the system together such that B = G, The 
expansion of the matrix Riccati (filter) equation, Eq. (3,9) with P ’ = 0 
yields 

2p !2 e + p ii/V = ° (3.21) 

p nd ; P 22 e - Pu p i 2 /V = ° (3.22) 

2P l2 d -(P^ 2 /$-n 2 W = 0 (3.23) 

Eqs. (3.21) - (3.23) can then be solved for the elements of the two 

dimensional symmetric P matrix as: 

p 12 = V(d+(d 2 +n^W/V)) i2 } (3.24) 

P 11 = - C-2eVP 12 )% (3.25) 

p 22 = C p lx /e) (d- (P 12 /V)) (3.26) 

Again, the sign in front of the radicals is selected such that P is 

positive definite. The filter gain, F, obtained from Eq. (3.8), with 
T 

H = [1 0] , is expressed as 

1 


F = 


V 


p 


F 

11 

= 

1 

P 12 


F 2 

« « 


b m 


(3.27) 


Thus, the linear model of the plant and the estimator equations 
become > 

X' =AX-BC X + Gw (3.28) 

X’ =(A-FH-BC) X+FH X+Fv (3.29) 
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The general scheme of the stochastic optimal control configuration 

represented by Eqs, (3.28) and (3.29) is shown in Fig. 3.2. This 

configuration is taken as the basis for studying the system behavior. 

(2) Average Performance of the System 

The average performance (RMS value) of the optimally controlled 

system, Eqs. (3.28) and (3.29), in the presence of plant and measurement 

12 

noises can be predicted from the covariances of the error and estimate. 

The state of the controlled system and the state of the estimator are 
coupled. In terms of e = X - X, Eqs. (3.28) and (3.29) can be written as 
e* = (A-FH) e + Fv-Gw (3.30) 

X' = (A-BC)X + FHe + Fv (3.31) 

A 12 
The covariance matrices of e and X (P and S, respectively) , are given by 

pr = ap + PA T -FVF T + GWG T (3.32) 

S’ = (A-BC) S + S (A-BC) T + FVF T (3.33) 

a rrr 

since E(Xe 1 ) = 0, we have. 

E [X(t)X(t) T ] = SM = S(t)+P(t) (3.34) 

These equations allow us to predict the mean square histories of the 

state variables and their cross-correlations. The mean square values of 

12 

the control variables and. their cross -correlations may be obtained as 

E [U(t) U(t) T ] = C S C T (3.35) 

In this section, the steady state analytical solution^ to the 
optimal stochastic control problem is given. The analytic solution is 
obtained from Eqs. (3.32) - (3.35) by using the steady state values of 
the control and filter gains obtained earlier. 
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By solving these equations for the special case of a single measurement 
of aOjAi) only, the steady state variances of the state and control are 
obtained as (x + «) : 


E [« 2 (t)] = S n = S u + P u (3.36) 
E [S 2 (t)] = S 22 = S 22 + P 22 (3.37) 
E [U 2 (t)] =■ c/ S u + 2G 1 C 2 S 12 +C 2 2 S 22 (3.38) 

where 

Sn = {VF 1 /(d-C 1 n)>{(C 2 n/2e)F 1 - F 2 > (3.39) 
S 12 = (V/2e)Fj 2 (3.40) 
S 22 =(V/C 2 n)(F 2 Z + (d-Cin) F i 2 /2e) (3.41) 


The elements P^ and P 22 are given. in Eqs. (3.25) and (3.26), respectively. 
This analytical approach can be very useful in preliminary design of 
sensor measurement schemes. ^ 


3. Numerical Results 

Some typical numerical results based on the solutions of Sec. 1 
and 2 of this chapter will now be discussed. The following system 

2 6 

parameters are considered here for numerical integration (Fig. 3.1) ’ : 
I - 1.42xl0 7 kg-m^ (10.5x10^ slug-ft^) 

= 2.03xl0 7 kg-m'^ (15.0x10^ slug-ft'') 

M = 6.21x10^ kg (4258 slug) 
m = 816 kg (55.95 slug) 

Q = 0,314 rad/ sec. (3 rpm) 
a = c = 19.8 m (65ft); b=d=0 
o)^(O) = 0.0391 rad/sec; oj 2 (0) = 0 
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Four different computer algorithms are required for the 
numerical solution: 1) the calculation of the control system 

gains using the matrix Riccati equation for the deterministic 

system (no-noise) 15 , 2) the calculation of the control system 

\ 

gains using the matrix Riccati equation with the filter algorithm 15 
i.e. - "filter gains," 3) a means of simulating random noise 
input to the plant as well as in the measurement device, 4) the 
simulation of the system dynamics using the control laws from 
1) and 2) and a model of the noise from 3). 

a. Two Axis Control with Single Offset Boom. 

(1) Single Measurement System 
When a single boom is offset from the z axis and the hub is 
symmetrical (I = 1^ = l ^) , it was shown earlier that the control 
and filter gains can be obtained analytically. The process of 
determining the weighting matrices for the nondimens ionali zed form 
of the state equations was given in Sec. 5 of the last chapter. 

Here the details regarding the determination of the covariances of 
the measurement and plant noises for the nondimens ionali zed form 
of the state and measurement equations are considered. 

The original state and measurement equations of the controlled 
system in the time domain are expressed as: 


The dimensionless equations corresponding to Eqs. (3.42) and 
(3.43) are: 

X' - AX+BU+Gw (3.44) 

Y = HX+v (3.45) 


Then, the covariances of the measurement noise (V) and the plant 
noise (W) in dimensionless form are related to their original (time 
domain) values by 
V = V 0 /S) 2 


W = W /£ 2 n 4 
o m 


= 0.04 rad/sec and SL = 5.4 m 
T m 

max 


With the values of u, 

(17.72ft), the following numerical values for the parameters 
result : 


d - 0.441, e = 0.428, n = 5.929x10 
The optimal control law ! for the values of 


-3 




^o 

0 


0 

.il 


, q = 625 rad 2 sec 2 


(3.46) 

(3.47) 


and R = [ r ] = 0.00372 m 2 sec 4 (0.04 ft 2 sec 4 ) are obtained 

o o 

as follows. The values of q and r in Eq. (3.18) are related to qQ and 


q = nq Q - = 196.25 

r = fcVr = 0.397 
m o 

Thus, the constant control gain matrix is obtained from Eq. (3.20) as: 
C = [-3.3188 31.366] 
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The matrix, H, in the measurement equation for a single 
measurement of only becomes 

H = [ 1 0] 

The covariances of the measurement and plant noises are assumed to 
have the following values: 

V Q = 1.0" 6 rad 2 sec" 2 

I W Q = 10" 6 ft 2 sec" 4 (0 . 093xl0 -6 m 2 sec' 4 ) 

j • : > • 

which appear to representative of the current capability of measurement 

devices. Then, the values of V and W are related to V and W by 

o o' 

V = V 0 /S2 2 = 0.1014xl0 -4 

W = W r /jr 2 ft 4 = 0.3276xl0 -4 
o m 

The filter gain is obtained from Eq. (3.27) as: 

0.010496ol 
-0.0001287J 

The dynamic responses of the system are obtained by integrating 
the linearized plant and estimator equations represented by Eqs. (3.28) 
and (3.29). The decay of nutation and the motion of the boom end 
ma?s is illustrated in Fig. 3.3(a). The nutation angle reaches a 

j • ■ ‘ 

value of 0.0142 deg. after 200 secs, from an initial value of 5.0 deg. 

■? j '*'■■■ : " 

It is seen that within 100-120 secs, (without damping in the boom 

extension mechanism) the transient part of the boom end mass motion 

is removed, leaving a remaining steady state oscillation with an 

amplitude of 38.5 ft. (11.74m); with the presence of boom damping shown, 

the amplitude of the boom motion has been reduced to essentially zero 

within 175 secs. 
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The random noise present in the sensor measuring scheme, v, 
which is simulated by generating random numbers with a zero mean 
Gaussian distribution, and the actual output of the sensor (Y^ = u^+v) 
are illustrated in Fig. 3.3(b). Also indicated are the time response 
of the transverse angular velocity components (w^,u) and their estimated 

A ^ ^ A i. 1 

values (uipO^ )• It is observed that the estimate of the state: t^) 

has a very good correlation with the actual state: (w^-c^)'*' for the 

given initial conditions. Within the plotting accuracy this difference 

can not be detected. 

Next, the case of a larger control mass and a larger main space- 
craft mass, as considered in the earlier chapter, is taken as an 
example for studying the dynamic response of the system. The values 
of the masses selected are : 

M = 19.98xl0 5 kg (1.37xl0 5 slug) 
m = 2.625xl0 4 kg (1800 slug) 
such that m/M remains at 0.013 (as in Fig. 3.3(a)). 

Figs. 3.4(a) and (b) show the time histories of the control and 

filter gains for the single offset boom case with the single measurement 

of angular velocity only. In all these cases, the responses i 

indicate that the transients are brief, and steady state values of K 

and F are rapidly reached. For this special case, the steady state 

control and filter gains are obtained analytically by solving the 

respective algebraic matrix Riccati equation. The plant noise and 

measurement noise are assumed to have covariance values of W = V = 10 ^ 
(dimensionless) .; " 
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The weighting matrices of state, Q, and control, R, are indicated 

i- 

in the figure. Also the steady state average performance of the 

12 

system is obtained analytically from the covariance of the error 
and estimate. The average value of the nutation angle from the 
covariance analysis of Sec. 2. a (2) is obtained as 0.02 deg. 

The dynamic responses of the system for constant (steady state) 

■j 

cbntrol and filter gains are shown in Fig. 3.5 for an initial nutation 
angle of 5.0 degrees. The spacecraft considered is spinning at an 
angular velocity of 8 s 0.314 rad/sec. about the ’z' axis. For 
the selected weighting matrices, Q and R, as shown, the decay of 
nutation angle is represented in Fig. 3.5(a) where the maximum 
amplitude of boom length is taken as 17.72 ft. (5.4m). The motion 
of the boom end mass during nutation decay is illustrated. It Is 
seen that, after approximately 25 secs, without damping in the 
boom extension mechanism, a steady state oscillation would remain 
with an amplitude of 13.69 ft. (4.17 m.); with the presence of the 
boom damping shown, the amplitude of the motion has been essentially 
reduced to zero within 100 secs. The random noise present in the 
sensor, actual output of the sensor and the transient response of 
the angular velocity components and their estimates are shown in 
Fig. 3.5(b). 

The effect of the intensity of the sensor and plant noise is 
considered next for the single measurement (oj^) scheme. 
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When the covariance is changed from the earlier value of W=V=10 ^ 

-4 

tola new value of 10 , the transient response of the system remains 

essentially unchanged except the steady state (RMS) value of the 
nutation angle is increased from 0.02 degree to 0.2 degree. 

(2) Two Measurement System 

The transient response of the filter gains (F) when both 
measurements and are made is shown in Fig. 3.6. The resulting 
dynamic response of the system for the larger control mass produced 
by! the constant control and filter gains coincides with the earlier 
case of single measurement of only. Also the system transient 
response for the deterministic case^ (no noise present) is compared 
with the stochastic system transient response and it is found that 

bojth have essentially the same response for the system parameters 

| ' 

and initial conditions considered here. It can be seen that the 
stochastic system has a steady state (RMS) nutation angle of 0.02 
degree which is not characteristic of the deterministic case.^ 

(This is consistent with the analytic result described earlier.) 

b. Three Axis Control Using Two Offset Booms 
For the general case of three- axis control numerical methods 
are used to solve the matrix Riccati equation. The dynamics of 
the controlled system are obtained by numerical integration of 
Eqs..(3.'28) and (3.29) as developed in Refs. 2 and 6. 
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The matrices A and B in Eqs. (3.28) and (3.29) for this 
application of two boom system for three axis control, using the 
larger control masses, with the selected system parameters are 
obtained as: 


A= 


b t = 


0.0018015 

-0.6667980 

O.Fl 

0.6667980 

-0.0018015 

0.0 

0 . 0 . 

0.0 

o.oj 

0.0082732 

0.637957 

0.0 

0.0 

0.0 

0.384811 


The reference length has been assumed to be 100 ft. (30.48m) and 
the control signals and plant noises are assumed to enter together such 
that B = G. In the measuring scheme all the variations of angular 
velocity components of the spacecraft from a nominal state are measured. 

The optimal control constant gain, C, obtained by solving the 

■ ’ ' 1 2 5 

matrix Riccati equation (Eq. (3.6)) numerically can be expressed as ’ : 



-2.2242 3.8489 

0.0 0.0 


0.0 

3.1401 


)1 


Similarly, the optimal filter constant gain, F, obtained from the 
steady state solutions of Eq. (3.9) can be written in the form: 


v _ 0.3607 -0.1047 0.0 

* " -0.1047 0.5045 0.0 

0.0 0.0 0.3848 

An example of the application of a two boom system for three 
axis control is shown in Fig. 3.7. where initial perturbations are 
assumed to be present in all three angular rates. The decay of nutation 
angle is showns in Fig. 3.7(a). 
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It is seen that the nutation is reduced to approximately zero within 
30 secs. Also, shown in the figure are the time responses of the 
z - boom motion when there is no damping present in the boom driving 
mechanism and when it is present. With the value shown in the figure 
for boom damping, the boom motion can be reduced to zero within 100 secs. 

The response of x - boom motion as shown in Fig. 3.7(a) increases 
linearly with time without any limitation. This is due to the fact 
that control of the spin angular velocity magnitude for the linearized 
system depends on the x - boom motion as seen from the numerical values 
of the matrices indicated earlier. Due to the stochastic disturbances, 
the angular velocity component about the T 3’ axis fluctuates from its 
nominal value, which forces the x - boom as shown in Fig. 3.7(a). As 
this is not desirable, a spring force is now assumed to be present 
in the x - boom mechanism as shown which brings the x - boom within 
a maximum amplitude of 23.5 ft, (7.16m). The damping present in the 
boom for the selected system parameters is very weak and, hence, 
additional damping in the x - boom driving mechanism is needed to bring 
the x - boom motion to zero value in a reasonable time period. 


The time responses of the angular velocity components and 

u >2 and their respective estimates and are illustrated in 

j 

Fig. 3.7(b). It is seen that the difference between the estimates of 


the- components of angular velocity and the actual values of these 


components is negligible within the plotting accuracy. 
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The spin angular velocity reaches the desired value of 0.314 rad/sec. 
from an initial value of 0.35 rad/sec. within 20 secs, and fluctuates 
with a small amplitude (not observable on the figure) which is 
responsible for the x - boom motion dissucssed earlier. 
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IV. CONCLUDING COMMENTS 

As a result of the analysis and numerical results the following 
conclusions regarding the time optimal and stochastic optimal control 
uiing telescoping booms can be made: 

A. TIME OPTIMAL CONTROL 

1. The time optimal control problem is solved analytically for 
a single offset boom where the initial conditions are such that the 
system can be driven to the equilibrium state with a single switching 
in the bang-bang optimal sequence. 

2. The large amplitudes of the single offset control boom dis- 
placement can be reduced to a reasonable practical value by increasing 
the size of the control mass. This also reduces the nutation angle 
steady state amplitude to a negligible value. 

3. For the general case where the initial conditions do not lie 
within the single switching region piecewise solutions can be used 
to obtain the system response. 

B. STOCHASTIC OPTIMAL CONTROL 

1. In the area of stochastic optimal control, the average 
performance of the controlled system in the presence of plant and 
measurement noises for the case of single boom offset system with 
the measurement of one of the transverse angular velocity components 
can be predicted from the covariances of the error and estimate. 
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2. The dynamics of spinning spacecraft using one or two movable 

I 

telescoping offset boom systems for the general case with stochastic 
inputs are obtained using numerical integration. It is seen that the 
difference between the estimates of the components of the angular 
velocity and the actual values of these components is negligble for 
the covariances, initial conditions, and system parameters considered 
here. 

3. In the case of three axis control using two orthogonal booms , 
the motion of the boom in a direction orthogonal to the spin axis 
increases linearly with time. This is due to the fact that control 
of the spin angular velocity magnitude for the linearized system 
depends on this boom motion. Due to the stochastic disturbances, the 
spin magnitude fluctuates from its nominal value, which forces the (x) 
boom. In order to remove this undesirable motion, additional damping 
in this boom driving mechanism and aspring force acting on the boom 
mass is needed. In the deterministic case, the spin magnitude reaches 
the desired value and remains constant; the motion of the (x) boom 
reaches a steay state (constant) amplitude. 


1 . 
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COMPUTER PROGRAMS 
A. TIME OPTIMAL CONTROL 


•LISTING 
-^~C . 


TIMg g°T. CCINTROL^NUM ... INT . -..-ML- .E-Q-N. 


EXTERNAL 8S0C1 ,8SOC2 

DIMENSION PARM C5 ) , Y (7) , DY (7) f WORK (8 #7) , SIZE (7) 
R E A L 1 1 , 1 2 , 1 3 -, MS 


COMMON Y 

COMMON II, 12, 13, MB, Ml, M2, LM 
COMMON , N ,M — 


COMMON 44, 88, CC, DO 
COMMON C C 3 , 3 ) 

E QIJ I V A L £ N C E. . Q L C l-L ^W-l..N_U.C^-C2-V^.2NA-,.tY-C3 


EQU I VALENCE ( Y (5 ) , OXN ) , ( Y ( 6 ) , ZN ) , ( Y ( 7 3 , XN ) 
CALL INOUT (2,5) 

■CALL OP E N... Cl , — *-SE L L A R P. AM.* — »5-»-I-E8-3 


IFCIERvNE.l)- STOP UNABLE TO OPEN PILE 
READ (2, 91 ) TMAX,STEP,T0L 
■ g £ AQC £, q . U - S-IZE — 1 — -1 


91 FORMAT ( 8F 1 0 . 0 ) 
PARMC 1)=0.0 
PARMf P’ts TMAX 


PARMC 3) -STEP 
INITIAL VALUES 
aejuu- 2 -^j. i x- i.i., r.?-,...L3^Aa- 


REA0(2,911) Ml , M2 , LM 
RE AD ( 2 , 9 1 1 ) AA,8B,CC,D0 
..<LU-.EnR.MjLU_aF 2 0.M 


' * 

■ 

P'l ' 

•< 

~f — 


WIN=0. 0391/0.3 14 
W2N= 0 r O'. • ■ ' 

J13N;: CO., 314-0. 31 4 3. /ft. 3 1.4 


DZNsO.O 
DXNsO .0 
..IN = . ( 1^0-.. 


XNsO.0 
N=7 . 
i±=3 


WRITECS,92) TMAX,STEP,TOL 
WR I T E C 5 , 95 ) 11,12,13 
JfltRI.tE.C5., -9 6) • M 1 , M ? , L M 


WR I TECS, 97) A A , SB ,CC * DD 
WRITE (5, 98) SIZE 
JiRtI£-C5-^5LRJ 


92 FORMAT C # 1TMAX=',F8,4, 10X, ' STEP= " , F8 . 4 , 1 0 X , ' JOL = ' , F8 . 6 3 
95 FORMAT ( '011=' ,r 15.2, 2X, *I2=',F15.2,2X,'I3=',F15.2) 

.9.6 ■ EOR M.ajlc.CQM ja t .5^2., Et,.CM2=J.^E.L5^.^2X,_lLii= .1,JL1.5.2J- 


: 97 F 0 R MA T ( ' 0 A A =• ' , F 8 .. 4 ,5 X »• ' 8 8- * , F 8 . 4 , 5 X , ' CC-' , F8 . 4 , 5X , ' DD= ' , F8 . 4 ) 

98 FORMATC ' OS IZE * ,7F8 . 4 3 • 

9 9 F QRMA.I.C M 1 ,..T6,.'T. 1 , T 1 T , J W 1 . L , T ..3.Q W .2.t,JL4J^J.Wl > ,.155 I 

2T69, ' DX * , T 6 t , ' Z ' , T94 , ' X * , T 1 08 , 'THETA', T115, * I..HLF ' , / ) 

CALL RKSCLCN, SIZE, DY,T0L, FARM) 

call-. r kgs-cpar.m^qy , N .,.iHLf-^asacx,.asoc2 ^ .qp.k.) 


WRITE.C5, 100) IHLF 
100 FORMATC 'OIHLFr ' ,13) 
CALt EXIX 


END 


PROGRAM IS RELOCATABLE 


•TITL .MAIN 


4-FQR.T /■ A-4B- / E / P / S F QR T -..LSVL- 


» LISTING 


SUBROUTINE BSOC t C T, Y , OY1 
-CX I M E M 5 - 1 0 N . . - Y - 


REAL II, 12, 13, MB, Mi, M2, LM 
COMMON W1N,W2N,W3N,0ZN,DXN,ZN,XN 

- CO MM 0 M- M^T2-^I-3.^a ,L M 

COMMON N , M 
COMMON A A, 89, CC, 00 
-COMMON— C — 'J. — 


TS=o.5a 

TF=6.12 

-IELCX^G-T ..TS4-GQ-JLQ-.aJl. 


C0s+0.03 
GO TO 30 V., 

a 0 .. ■ I F ( T .. GT . TF X-GO-tO- 50- 


C0=-0.03 
GO TO 30 
.5-0— CQ-Q.-Q 


30 CONTINUE 

CAL..OF.COEFF.FQR LHS OF MATRIX' EQN 


ULM=U*LM*LM 
NONOIMEMSIONALIZATION 
JLI-L=-UXULM 


AT2“1 2/ULM 
A 1 3 - 1 3 / U LiM 
XXS-AA/U4 


C2s88/LM 

C3“CC/LM 


U1=M1 *(M8 + M2)/C CMB+Mt +M2)*U) 
U2=M2*CMB + M1 ,)/CCMB+Ml+M2)*U) 


C C 1 , n=AIl+Ul*CC2*C2 + ZN*ZN)+U2*CC3*C3 + Ca*Ca) 
*-2.0*U3*(C2*C3+Ca*ZN) 

— C ( 1 C 2*X MX. 


CCt ,3I=-Ul*-(Cl*Z.N)-U2*Ca*XN + U3*(Cl*'Ca + ZN*XN) 
CC2, n=-U l*(Cl *C2}«U2*C3*XN+U3*(Ct*C3+C2*XN) 

*-2.0*U3*CCl*XN+ca*ZN) 

C'C2,3)=-Ul*CC2*ZN)-U2*G3*C« + U3*(C2*Ca + C3*ZN) 
— C (-3-,44-= i-_U-l-j^UZJl)-^iJ2JtC.^XM».U.3*-CC-l-*Ca--t-.IN * XMX. 


C.(3,2)=-Ui*(C2*ZN)-U2.*C3*CU+U3*(C2*C4tC3*ZN) 
•C (3, 3X S A 1 3+U 1 * CC t*C l.+C2*C2 ) >U2*( C3*C3 + XN*XN ) 

-^2-^U-3^^C2>:C-3-+-CT-*XMX 1 

CAL. OF RHS OF MATRIX EQN 
CN = C1/(AI1+C1*C). ) 

_Q.F-0_._0 


a,zn= 

A X Ns 

-SN-s-L 


(CO/CN)-OF*DZN-ZN 
0.0 
,4-- 




A 1 1 = 
A 1 2 1 
-M-2-2- 


(AI3-AI2)*W2N*SN 

=-C 1*ZN*W1N*W2N+ (C2*C2-ZN*ZN ) *W2N*SN+C 1 *C2 *W 1N*SN 
^2. w ^Z-M*.aZ^^ i /i-UMtC2i-Z--N^C-S-M*.SM-M2N *.M 2.M ) +-C2 *. A.Z.M. 


A 1 23 
A 1.2 ft 
-A-L2-S 


r-Ca*XN*Wl N*W2N>CC3*C3-Ca*C4) *W2M*SN+C3*XN*W 1 N*SN 
s-2.Q*C3*OXN*W2N-2.0*Ca*OXN*SN+C3*CU* (SN*SN-W2N*W2N) 


A 15 = -(Cl*Ca*ZN*XN) *wiN*W2N + 2.0* CC2*C3-CU*ZN) *W2N*SN 
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A l fe - ( C 1 *C 3 +C 2 *X N ) * W 1 N * SN +2 *C4 *D Z N* w t N -2. . 0 * C2 * D X N * to 2N 


A13=U3*CAl5tAl6+A17) 
OY ( 1 ) =- C A 1 1+A12-A13) 

d- a __ m > T i 1 V ^ V k. . ... * L t 


Bi2i : =-C2*ZN*WlN*W2N + Ct*C2*W2N*SN+ eCl*Cl-ZN*ZN) *SN*W1N 
Bi22=-2.0*ZN*OZN*W2N+C1*ZN*CSN*SN-W1N*W1N) +C1*AZN 






8124=-2. 0*XN*DXN*W2N+C4*XN*(SN*SN-W1N*W1N) -C4*AXN 
B12=Ul*CB12t+B122)+U2*CB123+B124) 




8I6=2.-0* CC 1 *XN-C4*ZN)*SN*WtN-2.0*(Cl*DXN + C4*OZN) *W2N 
8t7=CCi*C4+XN*ZN)*CSN*SN-WlN*WlN) +XN*AZN-ZN*AXN 


DYC2)=-CB1 1-B12+B13) 

Cils(AI2-Ain*WlN*W2N 

C 122=2 *0*Cl*DZN*wiN+2 ,.0*C2*DZN*W2N+C t *C2* (W1N*W1N-W2N*W2N) 
Ci23=(C3*C3-XN*XN) *W1 N*W2N-C4*XN*W2N*SN+C3*C4*SN*to IN 


C12=Ul*(C12t+C122)+U2*(C123+Cl24) 

C15=2.0*(C2*C3-C1*XN) *W l N*W2N- (C 1 *C4 *XN*ZN ) *W2M*SN 




• C 1; 7 = *2 * 0 * C l *0 X N * S N +•( Cl *C 3 ♦ C2 * X N. ) * C W 1 N * W l N - W2 N ★ W 2 N )> C 2 * A X N 
CX3=U3* (C t5+C16+C 1.7) \ 


- DY(4)=AZN 
DY (5) =AXN 




0Y(7}=0XN 

. CALL SIMQCC,DY,M>KS) 
r p r wf c v t . . ? . t 


2 RETURN 

3 WRITE (5; 4) 





PROGRAM IS RELOCATABLE 


J.F0RT/A/B/E/P/S FORT.LS/L 
1 LISTING 


LOGICAL -RKNXT 

OIMENSION YC7),DYC7),DUMMY(7) 

..aiME-MS-I-ON.. XC-11 

REAL 1 1 r 1 2 , 1 3, MB ,M i , M2 * LM 
COMMON to 1 N ,M ZH , W 3 N , D ZN , 0 X N , Z N , X N 
rflMMOM Tt .T5.T7.MCI.Mf .M3.I M 


COMMON N / M 
COMMON AA,8B,CC,D0' 

=51.^29 5X19 5 

CALL BSOCKT/Y, DUMMY) 
WS-0 . 3 1.4 


X ( 2 ) = Y ( 2 ) *WS 
X(3) = (l .0 + YC3) )*WS 

YNlV-VT/lUl M + WQ 


X(5)=Y(5)*LM*WS 

XC6)=Y(fe)*LM 


H1=I1*X(1) cn 






s 



H2sI2*X(2) 

■H3r. I 3. * . X(3 4 — — 

THETAsATAN 2 (SORT CHI ★H1+H2*H2) ,H3)*OEG 
TAsT/WS 


IFC .NOT.RKNXT ( IHLF) 3 GO TO 8 
WRITECSf 1) TP >X r THET A $ IHLF 

WRITE BINARY ( 1 ) T A , THET A , X C7 ) , X ( b ) , X ( 3 ) ,X ( 2 ) , X ( 1) 
8 CONTINUE 


PROGRAM IS RELOCATABLE 

1 .TITL 8SOC2 





B. KALMAN FILTER PROGRAM 


[LISTING 

— p-E— p pe-G R-A-fH-H— ; : — - • — 

; C RICCATI EQUATION PROGRAM CRICATI) 

? DIMENSION A(io,10),9(10,10),C(10,10),R(10,10),QC10,10), 

T » -K( 10, W-rQ-eirQ-rl- 0-hrX-( MO-rF-tt'Or* (hhrEM Or W -t 

7 ' * . G( tO , 1 0 ) , H ( 1 0 , 1 0 ) , S C l 0 , t 0 ) 

•••DIMENSION V C3 ,-3) ,LL.C3) ,MM(3) 

. — RE"A-fc — K 

; INTEGER OPTION, BLANK 

; common/kalman/icc, IFF, BLANK 

— 7” : WH^-I-e-e-rlPF-r 5-t A N K-/---C— *-,- J -F— * > * * * — 

. ; CALL INGUT C.2, 5) , • 

■ 1,000 FORMAT C IHT ,5X,.37H0PT I.MAL CONTROL/* ALMAN FILTER PROGRAM/) 

■■ ? v 1 Trg-)- — — — — — — — * — — — 

; 1003 FORMAT C1H0,5X,13H THE A MATRIX/) 

7 1004 FORMAT C1H0,5X,13H THE 8 MATRIX/) 

T" — titO-5~FOPM-A'T~t-H+0 - 7'5-X-7"l-3 H — THE-~C~MAr?R TX-/-> 

7 1 006 FORMAT C.8F 10*3) 

• ; t0«0 F OR M A T C 4 F 2. 0 . 0 ) /.v/T • 

— r~tO-0-7-FORM^-e-A-l-,-<?Xv2F 1-0-.-3-, T3-> 1 

; 1 008 FORMAT (,IH0,45(1H*) ) • 

7 1009 FORMAT (1H0,5X,21H*** FILTER OPTION ***/) 

—t T t04-0~-r U- R -M- ArP--H:R0-,-5X 7 ~22:H-* *-*—•£ QN-fR Qb— GP-TT 0 to-** *-/-y 

r/.lio 1 1 . FORMAT C6 C.1PE20 *8 ) ) y 

•'?.•• 1012 FORMAT C IHO , 5X, 13H. THE., R MATRIX/) V • , ‘ 

— r-^O-hS-FORFHA-T-e-tROTS-X-^ T3 H-T-RE-O-M-A-TR-I-X-AT— — — — — 

; 1020 FORMAT ( IHO , 5X , 1 3H THE V MATRIX/) 

? 1014 FORMAT (1H0,5X,19H INITIAL CONDITIONS/) 

T'~lrO''T5 _ r'FGR'M-A-T-TtH-0'7 : 5'X- 7 :8'H~TTM-£— s-'>~tP£-20"r8-/.6‘XT5HGAI NS) 

1.01 fc FORM A T C 1 H 0 , 5X , 2 1 HST E AD T STATE SOLUTION// 

•: 6X.,6H GAINS/) . ; „ 

~ — r~ — TO-O— RE -ato c~ 2 ~rto-crt ~) — Ny M-yt — — — — - — 

; WRITE C5, 10 00) 

; WRITEC5, 1001 ) N , M , L 

— 7 — "wR ' I T£ -t 7 S7~ l ' 0 ' 0 ' 6") " ' : — ■ ■ , ; : — 

. 7 • ... • s WRITE (5, 10 03) 

DO 110 I =• 1 /N' ' • s - 

7 — — ^eArD-f-2770-Oij*>- bAT'-h^J-hrU- - L - - — — 

? 110 WRITE C5, 10113 (ACI,J),J=1,N) 

7 WRITEC5, 1004) 

~~7 - 00 L20— T^l-rM 

7 ' REAQC2, 1006) (B(J, I) ,.J = 1,N) 

7 120 WRITE!. 5,1 0 1 1.) ( 5 ( J , I ) , J=1 , N ) 

— ; — WMHFg-t 5-,-hO-O 5-> — •- 

; 00 130 1=1, L 

7 READ (2,1006) ( C C I , J ) , J= l , N ) 

— ; t - 3 - 0 — O P T T ET-5- 1 OTt - ) (-e-H-rO~hrJ-hrNO 

7 150 READC2, 1007, END=999)- OPTION, T1 ,T2,NPT 

. ; • WRITE (5, 1008) 

—~7 : l F ( U PTT-UTreOr & t ANK->— G 0— TO— TOO — 

; IFCOPTION.EQ.ICC) GO TO 300 

7 WRITE (5, 1009) 

— . Hrrziz 

7 NQ=M 

' ' ^y^-^ -6i- 


DO 230 1=1# N 


21 0 ; eii*jv=cc J,n 

' 00 220 J=1#M 

- 2 20 — Q-^r-L~rx]-y =-B'f 'I-f-’J-} 
DO 230 J = 1#N 
230 FCI, J)=4(I,J) 

r — GO -T 0 -4 9-0- 

300 WRITE. (5, t.Q 10 3 


DO 330 1=1 #N 
DO 310 J=1#M 


a 30 VCI#J)=RCI # J) 

CALL M : IMV.tV>NR#.U#LL#WM} 

DO a 25 1=1# NR 

U25 WRITEC5# 10113 C V { I , J ) , J= 1 , NR 3 


: ou;- 44Q j=i #M 

: f rci#;j'3.=o.ot 

—9 G--4&-9— H-='-H“N R : 

44 0 RCl, J)=RCI, J)+V(I,II)*E(J, II) 
IF(OPTION.EQ.ICC) GO TO 500 

- — — - DO -45-0 — • 

• DO At 50 J=1,NQ 
GC1#J3=0*0 • 


450 G(l# J)=GcI# J) +0(1,11 )*QC II# J) 
00 460 1=1, N 

.. Da. - 4 60— J -s- t 7*f — — ; 

• ' Q C I, J)=0*0 : C - 

DU 460 11=1 #NQ 

-4«rO~# t-I- r J~r= Q-f-FrJO tGfb-Tf^^O (-J-, I~H~ 
500 IFCNPT.GT.O) GO TO 530 
DO 520 1 = 1, N 


510 G C I ,J)=0,0 
520 G C IV 17-1 

&FS-S-07-1' 

GO TO 570 
530 WRITE (5, 1014) 


• READ (2, 1006) CG C I, J) , J = 1 ,N) 
540: WRITE 15 ,1011) CGCI, J) , J=1#N'3 

WF-H-E-eS-H-0-08-) — 

TIi v £ = A0S ( T2-T 1 ) 
PTS=200.0*TI M E 


PTS/XX 








ID-ID* t 


ID = XX 

-w-a-ta 

W=ABS (XX -01 ) ' 

IF C.Y Y .GT ..0 *05) 

-I-T^P-FS — - 

EPS=0.005 

TIME=T1 

IF ( 0 P T 1 0 N ^-E D ;i CC - ) — 
WRITEC5, 1015) TIME 
DO- 560 1 = 1 , NR 

-&Q— 55i) — — 

KCI,J)=0.0 
DO 550 11=1, N 


-550- 

560 

570 


575 


-K-C I , - J 3 = I~I~r J -l 

WR I TE ( 5 ,1011) C K C I , J ) , J= 1 , N ) 
LC.= 0 - - : 

-I-€'H=ID- — 

DO 580 1=1, NR 
DQ 580 J= 1 , N 


— K C I - >'J )- -O-v0 — 

DO 580 I I =1 , M 

580 K ( I:, J) =K (.1 , J 5*R Cl ,11 ) *G(.I I, J) 


00 590 J=1,N 
HCI , J)=0 .0 
-DD-59-0—M =' tr NR- 


590 .HC.I , J) sH C I , J ) +E C 1 , 1 1 ) *K C 1 1 , J ) 
•'DO 610 1 = t , N 

-DfJ— 6 1-0— J = 1-,-N — •— 

D(I,J)=Q(I,J)' 

DO 60 0 1 1 = 1 , N 


-irO-O- 

610 


-6^0- 


625 


~ D ' CI ~ , ;r)-^tr ( - l7J '>*PC~~I-7-r'I~)-*~G-C-i~lTJ~)-*G~C~I~7-I- I-)-*-FC~JtI I ) G- FI * 'I I - )-*- H- M T 7 - JO- 
S' C I,.J ) ~G 0 1 , J ) *D C I , J) *EPS • 

TFC N P T * L E . 0 ) GO. TO .640 • ; ^ 

-t e-t e>t 1 — — — — — — - — 

IFCLC.LT. ICH) GO TO 625 
ICH=ICHtID 

- AbC^LC- - — ,— — — - — — — — — r-7- — ~ 

t=alc*eps ' ■ ... 

time=ti+t 

-IFCOP-T'ie^-eG-ri-eC-)— ■MME-S-F2---F— — — — 1 — 

WRITEC5, 1015) TIME 
DO 620 1=1, NR 

4 R- I - T E (.5 r -1 01 M - C K -t- I tTft-)' — . ■ : — .. ~ . — • ~ 

IF CLC .GE . IT) GO 
DO- 650 1 = 1, N V 
-DO— 63-0— J-=-F,‘ N— 


TO 150- 


630 GCI , J)=S( I, J) 

GO TO 575 

-tr*0 — SHOM-OtO 

DO 650 1=1, N 
. DO 650 J=1 , N 

— 3U MyS-ttM-rji-66-tDM-rJ-H — 

650 GCI, J)=SCI, J) 

I F ( SUM . GT • 0 . 0 1 ) GO TO 


575 


'^rUT f £ C ' 5 t 1 0t ' 6 ~ F 
D O' 660 1 = 1 , NR 
WRITE C5, 101 1) 


660 


CK Cl , J) , J=1,N.) 


- GO-TO t 5 ~0~ 
CONTINUE 
CALL EXIT 
-EftQ 


999 


..A*. 


! 



4 



-*T 






\ 3 US 


's-SC-- 







•« >* 







tsi 4 * 



P 



Jk 


-Fft^& RAM I S- P&b ££ -A^AFfcrE 

': ■ • ‘ , -. . . ,TITL ■ ■ .MAIN 

.^vlRLDR/M IMP/ S' 00.1 OPOi'.SSP.LB FORT, LB 
——i£X S C ' r ^ v: - — • — — — — — • — 


OPTIMAL CONTROL/KALMAN FILTER PROGRAM 


• 52 i 



THE A MATRIX. 


U.B0150000E -3 -6.66798000E -1 O.OOOOOOOOE 0 

6*667930 0 OE -1 -l.eOlSOOOOE -3 O.OOOOOOOOE’ 0 

-OvO-OO-OO-O-OOE 0 0-; O-Q-O-O-OO-30E 0 1 OtO^O-O 0-000 OE — 0 

THE 8 MATRIX 

8 ,2732030 OE -3 6,379570006 -1. O.OOOOOOOOE 0 

O.OOOOOOOOE 0 ' O.OOOOOOOOE 0 3.8U81 t-OOOE -1 


THE C MATRIX 


1. . 0 Q OD-Q-OtTOE 0 — O-.-Q-O 0 0‘0 0-O'OE— Ch — 0*7 O OO 0 0000 E — 0~~ 

O.OOOOOOOOE 0, l.OOOOOOOOE 0 O.OOOOOOOOE 0 

O.OOOOOOOOE 0 O.OOOOOOOOE 0. l.OOOOOOOOE 0 



— p-f-trT-ER — QP-7-i-G^— ****■ 


-”-T+{ E--R--M-A-TPI-X- — — — — — — — 

l.OOOOOOOOE -6 O.OOOOOOOOE 0 O.OOOOOOOOE 0 

6-rO-O^OiOQ-O^E — 0 — 1 t0G 0-0-0-000 £—6 0-. 0 0-000 60 QE- — 0 

O.OOOOOOOOE 0 O.OOOOOOOOE 0 l.OOOOOOOOE -6 

— -FHE-&-M-A-T R-I-X— L — — — — — - — - — - — — — 

l.OOOOOOOOE -6 O.OOOOOOOOE 0 

— ~Qt. 066-006-00' E— 0 - ■ - - — - t - . -O-frO-O O 0-00 E — ■&— — - 

' ' THE V MATRIX ' 


9 .999996 0 OE 5 ■ O.OOOOOOOOE 0 O.OOOOOOOOE 0 

O.OOOOOOOOE 0 9 .9999960 OE 5 O.OOOOOOOOE 0 

■076-0000 0 06' & " 6 -0T00000000E 0~ ■ 9r99999bQ-(tE — 5 

INITIAL CONDITIONS 


O.OOOOOOOOE 0 O.OOOOOOOOE 0 O.OOOOOOOOE 0 

O.OOOOOOOOE 0 O.OOOOOOOOE 0 O.OOOOOOOOE 0 

;0 VfrO ' Q OC hTOiHr: 0 — : O~70000OO 00E 0 — r 070-00 0 0 O00£ ; — 0 



-64- 


X :*■*■**** * 


C. THREE AXIS OPTIMAL ATTITUDE CONTROL 


1LI STING 


THREE AXIS CONTROL-TWO 800M SYSTEM 
EXTERNAL S0AC1/SQAC2 


Uli’lCINOiUlV r rt ^ A V/ JL # I 'J J , " U H r 

REAL II, I 2, 13, LM 
COMMON Y 


UUiirujin UiUflJiUH 

COMMON N 

COMMON W1 ,W2, VN1 ,VN2,VN3 


iArt X f , M m i 

■;COMMON IXW2, SW2,AMW2 
COMMON IXV1,SV 1 , AMV1 


COMMON IXV3, SV3, AMV3 

EQUIVALENCE CY Cl) ,W1N) , (Y(2) ,W2N) , (Y(3) ,W3N) 

TCrt 

EQUI VALENCE. C Y ( 7 ) , 0 2 N ) , C Y C 8 ) , D XN ) , ( Y C 9 ) ,ZN) , CY CIO) ,XN) 
CALL, IN OUT C 2, 5) 


IFCIER.NE.l) STOP UNABLE TO OPEN FILE 
READ(2 a91) TMAX,STEP,TOL 


Olit 

: READ C 2,90) I1,I2,I3,LM 
90 FORMAT C4F20.0) 


P ARM ( 1 ) =0 .0 
PARMC2) =TMAX 


r m r> » » 

N — 1 0 , 

W1N = 0.. 039 1/0.31 4 


"ci'i-u, u 

W3N=(0. 35-0, 314) /0.3ia 
EWINsO, 0391/0. 3ia 


c n c iv - u . u 

£W3N = C 0 . 35-0 .314 ) /0 .3 1 4 
' ' v DZN-0 .0 • 


OXN=0,0 

XN=0.0 


SW 1-0. 001 
AMWT = 0,0 


SW2=0.001 
AMW2=0. 0 


SV 1=0 ,001 
AMV 1=0.0 
txr?=-r2A- 5 
SV2=0.001 
AMV2=0 . 0 
tXV-3r=r?45 
SV-3 = 0.00 1 






WRITE (15,95 7 11,12,13 
WRITE (5, 98 3 SIZE 

9 ~ 2 — P&RM - A ' T '(~*~l~T M 'ft- XT r*'> F 8 ~ , 4 r~lrfl'XT~*~ 3 ~T ePsrVP 8 r^ 0 *r^et=^rF 
95 FORMAT! ' Oils', FI 5 . 2 , 2 X , * 1 2 = * , F 1 5 . 2 , 2 X , • 1 3 = * , F 1 5 . 2 ) 
98 FORMAT! 'OSIZE', 1 QF 3 , 4 ) 

M- 


CALL RKGSCPARM,:Y,DY,N, IHLF ,SQ AC 1 , SOAC2 , WORK ) 
CALL, EXIT 


' FORT/A/B/E/P/S FORT .LS/L 


SUBROUTINE SOAC1 (T,Y ,QY) 
DIMENSION Y(10),DY!10) 


COMMON W1N,W2N,W3N,EW1N,EW2N,EW3N,DZN,DXN,ZN,XN 
COMMON 1 1,12,1 3, LM 


COMMON W1 ,W2,.VNl ,VN2,VN3 
COMMON I XW 1 ,'SW 1 , AMW 1 

ir. 

C OMMQ N I X V 1 , S V 1 , A M V 1 
COMMON I X V2,SV2, AMV2 

e&*WN— IX-Y- 3 T-S-V- 3 T-AW 3 

CALL GAUSSClXWt,SWl,AMWl,WU 
CALL GAUSS!IXW2,SW2,AMW2,W2) 
EAtt — S~AiJ'S _ S~t~ 3 rX‘ V-lrrS V~lrrA M-V-trY N~ H 
CALL GAUSS(IXV2,SV2,AMV2, VN2) 
CALL.: GAUSS CI.XV3,SV3,AMV3,VN3) 

0*15 

A12 = 0. 866798 
811=0.0082733 


832-0 *384811 
Cil:=-2.22«2. 
et-2-=-lTP4-8^ — 
C23=3 , 14 
Fll=0.3607 
Pt^=-*-OT"lrO-4"7- 
F 13 = 0.0 
F22=0 .5045 


F33=0 .3848 
CD = 0 .2 

-AZN - a- ceil * E7rrNre-l-2-*-EW-2 NT- OChrO-ZN-ZN 

F 1=0 . 02598 

AXN=-!C23*Ew3N+F1 *OXN) -XN 

0 Y ( 1 ]'= Ail*' ?rr N-'A "1 Z* &TT *' CTT*' E fT- 8 T T* CTZ*- Ew-ZN-f ST r*T 1 

DY.".C2) = A 12*W1N-A 1 1*W2N-B2 1*C 1 1 *twlN-B21 *C 1 2*EW2N + B2 1 *W2 
DY!3)=-632*C23*Ew3N+832*w2 

" o t c 4 ) =TATi^'FTr a '8Tr*crri»‘ew-rfr-TAT2‘f : FT2"+ Err*- CT2T* e W2-N--FT3* ew-3 n- 

★ + F1.1*!W1N + VN1 )+Fi2* !W2N + VN2)+Fl3* !W3N + VN3) 

DYC5)=! A12-F12-B21*C1 1 )*EW1N-CA1 1 +F22 +82 t *C 1 27 +EW2N-F23* 

y+FI2* c w fN+vN i ) ■ - FF-2~2^^rzrrf-yN2~r-pr~zr*-0?r3wvfr3-) 

DY!6)=-F13*EW1N-F23*£W2N-(F33+B32*C23)*EW3N+F13*(W1N+VN1) 

★ + F23* CW2N + VN2 ) +r 33* CW3N + VN3) 

-tnrt?r=TZN 

D Y !8>=AXN 


iij 




DY (9) sOZN 


RETURN 


PROGRAM IS RELOCATABLE 


IFQRT /A/8/E/P/S F.ORT.LS/L 
1 LISTING- 


LOGICAL RKNx T 

OIMENSION Y(lO)fDYClO) , DUMMY C 10) 


REAL II ,12, 1 3', LM 

COMMON WlN,W2N,W3N,EwlN,Ev»2N,Ew3N, OZN,OXN, ZN,XN 




COMMON N 

COMMON W1,W2,VN1,VN2,VN3 


COMMON IXW2 , Sw2, AMW-2 
COMMON IXV1 ,SV1,AMV1 • 


COMMON IXV3,SV3,AMV3 
DEG = 57 « 2957795 


WSaO->3ta 
X(U=Y C 1) *WS 


XC3) = CY (3j +1 . 0 ) * W S 
x(4)=yC4)*ws 


X Cb) =CYC6)+1,0)*WS 
X (7 ) =Y C 7 ) *LM*WS 


X C9 ) =Y ( 9 j *LM 
X(10)=Y(10)*LM 


H2 = I2.*X C2 ) 

H3s-I3*XC3) 

— THE1"A^^rATr2"tSOR'T'( HT* H‘r+R2*'H1Il7R3'I* r D'E G : 

TAsT/WS 
TPsTA+0 .00005 

— r ^ - C TNOTTRKitx-r riH cp-rr- Go-ro-a — — ■ — 

~ WRITE (5, 1) TP,X(l),X(a),X(2),XC5),XC3),X(6),XC9],XC10),THETA,IHLF 
1 FORMAT C iX,F9.U,8F13.7,F9.4, 12) 

— 8-I-N-ARrt-rr- T -^IRE-T-AT-x-e-irt)-)-TX-e9-)-rX-(-fe-)-7rX-ll)-r^e5-)-rX-I2->-7-x-ia-y7-x-lth- 
8 CONTINUE 
RETURN ' 


PROGRAM IS R"Et7& C'A~TTrBt: E ; 

. T ITL SO AC 2 

1RLDR/M TMP/S 001 002 003 DPOiSSP.LB F0RT.L8 


DELETED SELLAPPAN 
ICREATE SELLAPPAN 












